#ifndef SERVO_CONFIG_H_
#define SERVO_CONFIG_H_

#define ARM_SHOUL_PAN_PIN 2
#define ARM_SHOUL_ELE_PIN 3
#define ARM_ELBOW_PIN 4
#define ARM_WRIST_PIN 5
#define ARM_GRIP_PIN 6
#define ARM_TWIST_PIN 11

#define ARM_SHOUL_PAN_DEFAULT 1500
#define ARM_SHOUL_ELE_DEFAULT 1330
#define ARM_ELBOW_DEFAULT 1270
#define ARM_WRIST_DEFAULT 1300
#define ARM_GRIP_DEFAULT 1500
#define ARM_TWIST_DEFAULT 1500

#define MAST_ELE_PIN 12
#define MAST_PAN_PIN 13

#define MAST_ELE_MAX 1850
#define MAST_ELE_MIN 1010

#define FR_STEER_PIN 10
#define FL_STEER_PIN 8
#define RR_STEER_PIN 9
#define RL_STEER_PIN 7

#define FR_JOG 25
#define FL_JOG 12
#define RR_JOG -5
#define RL_JOG 0

#define SERVO_DEFAULT 1500
#define SERVO_MAX 2500
#define SERVO_MIN 500

#define SERVO_MS_SCALE 4

#define SERVO_PWM_DEFAULT 128
#define SERVO_PWM_MAX 255
#define SERVO_PWM_MIN 1

#endif
